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FIELD-OF-VIEW SENSORS 


Yang Cheng*, John L. Crassidis^ and F. Landis Markley* 


The QUEST measurement noise model for unit vector observations has 
been widely used in spacecraft attitude estimation for more than twenty 
years. It was derived under the approximation that the noise lies in the 
tangent plane of the respective unit vector and is axially symmetrically 
distributed about the vector. For large field-of-view sensors, however, this 
approximation may be poor, especially when the measurement falls near 
the edge of the field of view. In this paper a new measurement noise model 
is derived based on a realistic noise distribution in the focal-plane of a large 
field-of-view sensor, which shows significant differences from the QUEST 
model for unit vector observations far away from the sensor boresight. An 
extended Kalman filter for attitude estimation is then designed with the 
new measurement noise model. Simulation results show that with the new 
measurement model the extended Kalman filter achieves better estimation 
performance using large field-of-view sensor observations. 

INTRODUCTION 

A TTITUDE determination is the identification of a proper orthogonal rotation (attitude) 
matrix that maps sensed vectors from a reference frame into the sensor frame. If all 
the measured and reference vectors are error free, then the rotation matrix is the same for 
all sets of observations. However, if measurement errors exist, then a least-squares type 
approach must be used to determine the attitude. Several attitude sensors exist, including: 
three-axis magnetometers, sun sensors, Earth-horizon sensors, global positioning system 
(GPS) sensors and star trackers. Reference [1] provides detailed descriptions of each of 
these sensors. The specific choice for the complement of onboard attitude sensor hardware 
is mostly driven by the individual requirements of the spacecraft mission. For example, for 
low accuracy requirements, such as a few degrees, a three-axis magnetometer can be used 
solely to determine three-axis attitude coupled with gyroscopes or a dynamic model [2]. 
The Solar, Anomalous, and Magnetospheric Particle Explorer (SAMPEX) is an example of 
a highly successful mission that employs only a three-axis magnetometer and a coarse (0.25 
degree) sun sensor coupled with a dynamic model [3]. 

* Postdoctoral Research Fellow, Department of Mechanical & Aerospace Engineering, University at Buffalo, State 
University of New York, Amherst, NY 14260-4400. E-mail: yangc0@yahoo.com. 

^Associate Professor, Department of Mechanical &: Aerospace Engineering, University at Buffalo, State University 
of New York, Amherst, NY 14260-4400. E-mail: johnc@eng.buffalo.edu. 

^Aerospace Engineer, NASA Goddard Space Flight Center, Guidance, Navigation and Control Systems Engineering 
Branch, Greenbelt, MD 20T71. E-mail: Landis.Markley@nasa.gov. 


1 


For missions with tight attitude knowledge requirements, the primary means to deter- 
mine attitude is the star tracker. The technology behind star trackers has changed much 
over the years. Evolving from gimballed to fixed-head, the latest star trackers now use 
charge-coupled devices (CCD) for imaging, which offer high accuracy [4]. By using star 
image centroiding, accuracies of approximately 1/10 the size of a pixel can be achieved. 
For small field-of-view (FOV) star trackers, this leads to off-boresight attitude knowledge 
on the order of 10 to 20 arcsec. Star trackers fall into the category of line-of-sight (LOS) 
sensors since they measure the direction of a celestial body. In particular, the angle of that 
body is measured from the sensor boresight in two mutually orthogonal planes [5]. With 
the advent of low-cost CCD arrays and powerful processors, the use of star trackers is more 
common today. 

For LOS sensors the observation equations are given by the well-known collinearity 
equations [6], which relate image plane coordinates to object plane coordinates through 
an attitude rotation. For stellar applications the light sources can be treated as infinite 
distance points, so that the only unknown, once a star is identified, is the attitude matrix. 
All attitude sensors, including star trackers, contain noise in their measurements however. 
This noise includes both systematic errors and random errors. Systematic errors are re- 
duced through calibration procedures, which can even be done on-orbit [7]. Random errors 
are usually treated as zero-mean Gaussian white-noise processes with known covariance. A 
realistic covariance matrix takes into account an increase in the errors away from the bore- 
sight due to radial distortions and contains correlated terms. A frequently-used covariance 
model for the noise added to the collinearity truth equations is given by Eq. (10) of Ref. [8]. 
This model is referred to here as the “focal-plane model.” 

The collinearity equations are usually cast in vector form since the attitude matrix 
appears linearily in this form. This unit vector form, also called the “LOS measurement 
model,” is the most widely used observation equation in attitude determination [9]. Recent 
research has also shown that using the unit vector form produces better results in a filter 
design over the standard collinearity equations form for the observation equations [10]. 
This is due to lower nonlinearity of the LOS measurement model and boundedness of the 
LOS measurements. Unfortunately, the measurement noise is also transformed when the 
collinearity equations are converted into the unit vector form. A simple covariance model 
that is valid for small FOVs has been developed by Shuster and Oh [9], called the “QUEST 
measurement model,” which is a singular matrix that arises for the unit-normalization of 
the observations. The beauty of this model is in its simplicity, which is evident in its use 
in the extended Kalman filter (EKF). In particular, Shuster [8] has shown that the singular 
covariance matrix can effectively be replaced with a nonsingular isotropic matrix, thereby 
providing practical use in the EKF. 

In this paper the QUEST measurement model is replaced with a general model that 
is valid for large FOVs. New sensors are evolving that incorporate wider FOVs, which 
may lead to degraded performance when using the QUEST measurement model. One such 
sensor is the vision-based navigation (VISNAV) system [11], which comprises an optical 
sensor of a new kind combined with specific light sources (beacons) in order to achieve a 
selective or “intelligent” vision. The sensor is made up of a Position Sensing Diode (PSD) 
placed in the focal plane of a wide angle lens, which yields a 100 degree FOV. When the 
rectangular silicon area of the PSD is illuminated by energy from a beacon focused by the 
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lens, it generates electrical currents in four directions that can be processed with appropriate 
electronic equipment to estimate the energy centroid of the image. The new measurement 
model is derived using a first-order Taylor series expansion approach of the observation noise 
model. This makes the assumption that the noise is “small” compared to the signal. It will 
be shown that this model can produce more accurate results than the QUEST measurement 
model for the VISNAV sensor. Unfortunately, as is the case with the QUEST measurement 
model, the new covariance is also singular, which causes a problem in the computation of 
the Kalman gain. To overcome this problem, two solutions are presented. The first is based 
on a matrix decomposition of the new covariance and the second is based on a rank-one 
update. 

The organization of this paper proceeds as follows. First, the collinearity equations are 
summarized, followed by the introduction of the focal-plane covariance model. Then, the 
QUEST measurement model is reviewed. Next, a new covariance model is derived that 
is valid for large FOVs. Its implementation in an EKF design is then shown by using a 
measurement transformation approach as well as a rank-one update approach. Finally, 
simulation results are shown that compare EKF results with the QUEST measurement 
model versus the new measurement model using VISNAV sensor observations. 

OVERVIEW 

In this section the collinearity equations are summarized for close range photogrammetry 
applications using the VISNAV sensor. A covariance model for the focal-plane equations is 
also summarized and the QUEST measurement model is shown. 

Collinearity Equations 

Photogrammetry is the technique of measuring objects (2D or 3D) from photographic 
images or LOS measurements. Photogrammetry can generally be divided into two cate- 
gories: far range photogrammetry with camera distance settings to infinity (commonly used 
in star cameras), and close range photogrammetry with camera distance settings to finite 
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values. In general close range photogrammetry can be used to determine both the position 
and attitude of an object, while far range photogrammetry can only be used to determine 
attitude. The VISNAV system comprises an optical sensor of a new kind combined with 
specific light sources (beacons), which can be used for close range photogrammetry- type ' 
applications. The relationship between the position/attitude and the observations used in 
photogrammetry involves a set of collinearity equations, which are reviewed in this section. 
Figure 1 shows a schematic of the typical quantities involved in basic photogrammetry from 
LOS measurements, derived from light beacons in this case. If we choose the z-axis of the 
sensor coordinate system to be directed outward along the boresight, then given object 
space and image space coordinate frames (see Figure 1), the ideal object to image space 
projective transformation (noiseless) can be written as follows [ 6 ]: 


_ _ n(Xj — x) + Au(Yj — y) + A\z{Zj — z) 

ai ~ A 31 (Xi -x) + A 32 (Yi -y) + A 33 (Zi - z) ’ 

ft _ — x) + A 22 (Yj — y) + ^23 (Zj — z) 

Pi " Az^Xi - x) + AniYi - y) + A 33 (Zi - z ) ’ 


* = 1, 2, ...,N 

(la) 

i = 1, 2, N 

(lb) 


where N is the total number of observations, (a:*,/?*) are the image space observations for 
the i th LOS, (Xi, Yi , Zi) are the known object space locations of the i th beacon, (a;, y, z) are 
the unknown object space location of the sensor, / is the known focal length, and Ajk are 
the unknown coefficients of the attitude matrix, A . In general the observations can be given 
by oti/f and /%//, so we can assume f — 1 without loss in generality, which is done for 
the remainder of this paper. The goal of the inverse problem is given observations (a*,/?*) 
and object space locations (X^ Yi, Zi), for i = L, 2, . . . , N, determine the attitude (A) and 
position (x, y, z). Note that if the beacons are “infinitely away” then Eq. (1) reduces down 
to the standard stellar collinearity equations. 


Denoting a* and fa by the 2 x 1 vector 7 * = [ai fa ] T , then the measurement model 
follows 

7i = 7t + w » ( 2 ) 

where a frequently used covariance for w* with / = 1 is given by [ 8 ] 


^FOCAL 


1 + d (a? + /??) 


\l + da}) 2 
_ ( dotifa ) 2 


(daiPi) 2 

(1 + d/3 2 ) 2 . 


( 3 ) 


where d is on the order of one and a is assumed to be known. Note that as ai or fa 
increase then the individual components of i?? 0CAL increase, which realistically shows that 
the errors increase as the observation moves away from the boresight. Also, as stated in 
Ref. [ 8 ], the covariance model is a function of the true variables ai and fa, which are never 
available in practice. However, using the measurements themselves or estimated quantities 
in the EKF leads to only second-order error effects. 


Unit Vector Form 


The observation can be reconstructed in unit vector form as 

bi = Ari, i = 1 , 2, . . . , N 


( 4 ) 
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where 


r i 


b ,= 


-OLi 

~Pi 


\A+<*?+$ L i 


v /(X i -x)2 + (r i - 2/ )2 + (Z i -z)2 


Xi- x 

Yi-y 

Zi — z 


(5a) 

(5b) 


When measurement noise is present, Shuster and Oh [9] have shown that nearly all the 
probability of the errors is concentrated on a very small area about the direction of Ar* , so 
the sphere containing that point can be approximated by a tangent plane, characterized by 

b i = At i + v iy vf Ari = 0 (6) 

where b * denotes the i th measurement and the sensor error is approximately Gaussian, 
which satisfies 


E {vi} = 0 (7a) 

^QUEST = E {^T} = ^2 [ /3x3 _ (^ r .) (j4r .)r] (7b) 

where E{ } denotes expectation and Is X 3 denotes a 3 x 3 identity matrix. Equation (7b) 
is known as the QUEST measurement model Shuster has shown that for af + /3f 1, the 

QUEST measurement model agrees well with the inferred model for the real sensor given by 
Eq. (3). Note that Eq. (7b) is also a function of the unknown truth quantities. However, the 
advantage of using the QUEST measurement model is that the measurement covariance in 
the EKF formulation can effectively be replaced by a nonsingular matrix, given by erf 1^3 
(see Ref. [8] for more details). 

New Model 


To derive a covariance for the actual unit vector measurement, the true values for a% 
and Pi must be replaced with the measured ones in Eq. (5). Performing this replacement 
does not explicitly yield the form given by Eq. (6) because the actual model cannot separate 
Ari from the noise. Hence, the actual noise model contains nonlinear terms coupled with 
non- Gaussian components. In order to derive a covariance, the new measurement model is 
based on a first-order Taylor series expansion of the unit vector model in Eq. (6). Note that 
this approach does not make the small FOV assumption, but rather it makes the assumption 
that the measurement noise is “small” compared to the signal, which is valid for every star 
tracker and for the VTSNAV sensor as well. The Jacobian of Eq. (5a) is given by 


-1 0 ’ 
0 -1 
.0 °_ 

The new covariance is now given by 


dhj _ 1 


1 


1 +<*? + $ 


bj \&i Pi\ 


^NEW 


= JiR\ 


FOCAL t T 


(S) 

( 9 ) 


Clearly, R^ EW is a singular matrix, just as Eq. (7b). It will be shown that the eigenvector 
associated with the zero eigenvalue of Rf EW is Ar*, which is exactly the same eigenvector 
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associated with the zero eigenvalue of Rf UEST . Since #^ UEST has two repeated eigenvalues, 
cr 2 , then the associated eigenvectors, which are always in the plane perpendicular to Ay { , 
are not unique. Therefore, without loss in generality it can be assumed that i?9 UEST has 
the same eigenvectors as i?^ EW . Thus, the only differences between these two covariances 
are their nonzero eigenvalues. The covariances are identical, i.e. i?f EW = i?^ UEST , when 
i?f OCAL i s given by 

1 -f a 2 

Rj 0CAL = a 2 ( 1 + a 2 + /3 2 ) (10) 

. otifii 1 + f3f_ 

which agrees with the corrected result shown in Ref. [12]. This shows that in order to 
recover i?^ UEST , the errors also should not be constant over the FOV. Note the differences 
between Eq. (3) and Eq. (10) though. However, for small FOVs the condition of + /?? 1 

is valid, so Eq. (10) agrees well with Eq. (3) in this case [8]. 

EXTENDED KALMAN FILTER IMPLEMENTATION 

In this section the new covariance is implemented in the EKF. Two approaches to 
overcome the singularity issue in the EKF are presented. The first is based on an eigen- 
value /eigenvector decomposition of i2^ EW and the second is based on a rank-one update of 
the covariance matrix. Only attitude estimation is considered here. The VISNAV sensor 
is capable of determining position as well, but this is an easy extension of the attitude 
estimation problem by simply augmenting the state vector. The EKF equations follow the 
multiplicative quaternion approach of Ref. [13], which includes the three-component atti- 
tude error vector and gyro-bias errors. Unfortunately, straightforward implementation of 
the EKF with the new model is not possible. The Kalman gain for a single observation, 
written in terms of using the true values for now, is given by [14] 

K = P~Hf [HiP-Hf + EW ] _1 (11) 

where P~ is the propagated 6x6 covariance matrix and Hi is given by [13] 

fii = [[i4r,x] 0 3x3 ] (12) 

where [Ar^x] is the standard cross product matrix (see Ref. [13]) and 03x3 is a 3 x 3 matrix 
of zeros. We now investigate the properties of the matrix Zi = HiP~Hj + Rf EW , which is 
known as the innovation matrix. In the EKF formulation the estimated values will be used 
to form the matrices HiP~ Hf and Rf EW . Hence, for the analysis of the matrix Zi we can 
set b i — A*i without loss in generality for now. From the definition of the cross product 
matrix it is easy to see that Hj'hi = 0 . Performing the multiplication Jfbi also gives 
Jfbi = 0. Hence, Z/bi is always zero, which means Zi is always singular. Furthermore, 
since the rank of i?f OCAL is two, which means the rank of Rf EW is also two, then b i is the 
eigenvector associated with the zero eigenvalue of i?f EW . The singularity problem always 
exists no matter how many measurements are used in the EKF. Therefore, the standard 
EKF cannot be executed. 

The specific form for the EKF follows Murrell’s version [15], which processes one unit 
vector observation at a time through a sequential approach. This approach reduces taking 
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Figure 2 Computationally Efficient Attitude Estimation Algorithm 


an inverse of a 3N x 3N matrix for the Kalman gain to taking an inverse of a 3 x 3 matrix N 
times, which significantly reduces the computational load. A flow chart of Murrell’s version 
for the update is shown in Figure 2, where and /3 + are the propagated and updated gyro- 
bias estimates, respectively, is the updated 6x6 covariance matrix, Ax“ and Ax + are 
the propagated and updated state corrections for the attitude and gyro bias, respectively, 
and A(q - ) is the attitude matrix parameterized using the propagated quaternion estimate, 
q“. Note that the gain in this flowchart uses the QUEST measurement model approach, 
with Ri = a 2 / 3 X3 . The first step involves propagating the quaternion, gyro bias and error- 
covariance to the current observation time. Then, the attitude matrix is computed. The 
propagated state vector is now initialized to zero. Next, the error-covariance and state 
quantities are updated using a single vector observation. This procedure is continued, 
replacing the propagated error-covariance and state vector with the updated values, until 
all vector observations are processed. Finally, the updated values are used to propagate the 
error-covariance and state quantities to the next observation time. 


7 









Decomposition Approach 


The eigenvalue/eigenvector decomposition of i?^ EW can be written in the form given by 


pNEW rp TP rpT 

— J-z 

s[ti t 2 t 3 ]. 


Ai 

0 

0 


0 O' 

a 2 0 

0 0 


[tl t 2 t 3 ]f 


(13) 


where ti, t 2 and t 3 are the eigenvectors, and Ai and A 2 are the nonzero eigenvalues. A 
linear transformation of the measurement residual in Figure 2 is now performed, giving a 
new residual df 




e i 

9i 



(14) 


where e* is a 2 x 1 vector made up of the first two components of dj and gi is the third 
component of dj. Since t 3 = A(q~)r t , then the transformed sensitivity matrix has the form 



02x3 

0 T 


(15) 


where % is a 2 x 3 matrix and 02x3 is a 2 x 3 matrix of zeros. Hence, only the vector e* is 
needed to perform the updates. These equations are now given by 

K = P~Ti[{HiP~7if + Aj] -1 (16a) 

p + = [/6X6 - IC KilP- (16b) 

Ax + = Ax“ + 1C (ei - TfjAx") (16c) 


where 'H , 

fiNEW. 


[% 0 2x3 ] and Aj is a diagonal matrix made up of the nonzero eigenvalues of 


Ai = 


Ai 0 
0 A 2 


(17) 


Note that the matrix inverse in the Kalman gain reduces from a 3 x 3 matrix to a 2 x 2 
matrix. Also, since A* is a diagonal matrix, then a sequential process can be used to process 
each component of e* one at a time [14]. This reduces taking a 2 x 2 matrix inverse down 
to taking an inverse of a scalar twice, which further reduces the computational load. The 
quaternion and gyro-bias updates are given by 


Ax + = [<5a +T A$ +t ] T (18a) 

q+ — q~ -f re-normalize quaternion (18b) 

/3+=/3- + A0+ (18c) 

where 5a is the angle correction, A/3 is the bias correction and H(q“) is a 4 x 3 matrix 

given by 

(19) 


H(q-) = 


+ [p x ] 

— T 

-p 
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with q~ = [p~ T q~±} T ■ The propagation equations remain unchanged, which are not shown 
here for brevity (see Ref. [13] for more details). In order to further enhance the numer- 
ical properties of the algorithm, a U-D factorization [14] of the covariance update and 
propagation is employed. The main advantage of this approach is that the factorization is 
accomplished without taking square roots, unlike a square-root filter, and the formulation 
does not add much computational effort over the standard EKF. The new model uses the 
specific covariance shown in Eq. (3), but it is important to state that any covariance matrix 
can be used in this formulation. The eigenvalue/eigenvector decomposition can easily be 
performed using numerical techniques. 

Rank-One Update Approach 

An alternative approach to overcome the problem of the EKF due to the singularity 
of the new measurement covariance matrix is shown. The main idea of the approach is 
to add an extra term, cbjbf (c > 0), to the singular measurement covariance matrix 
to ensure that the modified measurement covariance matrix is nonsingular. After this 
modification the standard EKF equations are used, as shown in Figure 2. The EKF with 
the modified measurement covariance matrix will yield the identical measurement update 
result with the one employing size-reduced residuals and measurement covariances. This 
approach is a straightforward extension of Shuster's approach in Ref. [8] to overcome the 
problem with the singular QUEST measurement covariance matrix (and singular innovation 
matrix). In Ref. [8] the original QUEST measurement covariance matrix in the standard 
EKF, i?^ UEST = af (hx 3 - b*bf), is replaced by 7 z9 VEST = <t?/ 3x3 , with the modification 
to the QUEST measurement covariance given by 

^QUEST = ^QUEST ^ a 2 b , b T ( 20 ) 

Again note that #^ UEST bj = 0. 

For the new measurement model, we propose to modify the singular measurement co- 
variance matrix, i?^ EW , in a similar manner: 

^NEW = i? NEW + c . b . b r (21) 

with Ci > 0. For any Rf EW derived from i?f OCAL , it is also true that i?f EW b* = 0, which 
is a direct result of Jfbi = 0. The inverse of 7Zf EW is then given by 

(' Tlf EW ) _1 = (i?P w ) f + -bib f (22) 

Ci 

where (i^EW)t ma y ] De interpreted as the pseudo-inverse of Rf EW or simply a convenient 
notation. Pre-multiplying both sides of Eq. (22) by Hf leads to 

hT (rNEW)- 1 = H J (jjNEWjt + h t . i bib T = h t (jjfBW)* (23) 

Ci 

Note that because Hfhi = 0, the identity holds regardless of the value of c; > 0. The limit 
oiHf (ftNEW)- 1 as Ci approaches zero is Hf (i?^ EW )^ as well. Similarly, for all C{ we have 

Hf (nf EW ) _1 Hi = Hf (Rf ] EW ) f Hi (24) 
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The inverse of TZf EW always exist since the eigenvalues obey [16] 

A^ NEW ) = Xj(Rf EW ) + mj Ci, j = 1, 2 , 3 (25) 

with mi + m 2 + m 3 = 1. In fact the eigenvalues and eigenvectors of TZ^EW are identical to 
the ones of Rf EW > except that the zero eigenvalue of Rf EW is replaced with c*. Since c\ is 
assumed to never be zero, then the inverse of 7£f EW always exists. 

The measurement update of the covariance matrix and the computation of the Kalman 
gain matrix with the original and modified measurement covariance matrices may be re- 
written as 

(P + ) _1 = (P -) -1 + Hj (Pf EW ) f Hi (26) 

K = P + H7 (Rf™)' (27) 

and 

( P +)- 1 = (P -) _1 + Hj (pf EW ) -1 Hi (28) 

K = P + H? (Pf EW ) _1 (29) 

From the two sets of equations and Eqs. (23) and (24), we can see that any 7£^ EW will 
lead to the same and K and thus to the same measurement update result as Rf EW 
does. Therefore, the use of 7£f EW overcomes the singularity problem, but does not alter 
the result of the EKF. Finally, we note that 

1. There is no limitation of the parameter c* > 0 in order to guarantee non-singularity of 
the measurement covariance matrix and the innovation matrix. Physically, c* is small 
because the error along the true boresight of the effective unit vector measurement 
converted from the focal-plane measurement is much smaller than the errors along 
the other two directions (the first order approximation of c\ is zero). For numerical 
purposes, however, c* may be chosen to be 

Ci = ^ trace (i?^ EW ) (30) 

where trace denotes the trace of a matrix. That is, c* is the average of the nonzero 
eigenvalues of i^ EW . Note that using Eq. (30) on i?9 UEST instead of Rf EW . gives 

■ Ci — a 1 , which yields Eq. (20). 

2. The parameter c* will change the property of the measurement covariance matrix, but 
not that of Hj (t^kW )- 1 Hi. If Hj (7£f EW ) _1 is ill-conditioned, the approach 
does not help. 

3. Since Hj ( 7 Zf™)" 1 Hi remains unchanged with the modified measurement covari- 
ance matrix, there is no information loss or gain in the EKF. 

4. The approach overcomes the singularity problem based on the very special structure 

of Hi and Hfhi = 0 and Rf EW bi = 0 . However, if the system does not have 

such a special structure, the innovation matrix in the EKF will not be singular and 
the problem no longer exists. 
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(i) Availability of First Four Beacons (ii) Average Angle from Boresight 


Figure 3 Availability of Beacons and Average Angle from Boresight 

SIMULATION RESULTS 

In this section the simulation results using synthetic VISNAV measurements are pre- 
sented. The VISNAV sensor is only used here to determine attitude for the simulation 
results. As previously stated, position can also be determined by augmenting the EKF 
state vector. Eight beacons are used to create the synthetic measurements. The beacon 
locations in meters are given by 


Xi = 5 , 

Y\ — 5, 

Z i =0 

(31a) 

*2 = 5 , 

Si 

ii 

i 

cn 

EX} 

to 

II 

O 

(31b) 

*3 - - 5 , 

o 

II 

.CO 

bsj 

lO 

II 

X 

(31c) 

*4 = - 5 , 

$ 

ll 

i 

o\ 

II 

o 

(310) 

•- *5 = 0 . 2 , 

r 5 = o . 2 , z 5 = o 

(31e) 

*6 = 0 . 2 , 

y 6 = - o . 2 , z 6 = o 

(31f) 

*7 = - 0 . 2 , 

Y 7 = 0.2 

Z 7 = 0 

(31g) 

*8 - - 0 . 2 , 

r 8 = — o . 2 , z 8 = o 

(31b) 


The first four beacons are spread out further than the last four beacons. A 30 second simu- 
lation is used with a sampling rate of 100 Hz for both the VISNAV and gyro measurements. 
A docking-type motion with a rotation is used in the simulation. The linear motions for 
both the x and y axes are zero for the entire simulation run. The vehicle performs a linear 
motion maneuver along the z axis starting 30 meters away at the initial time and ending 
at 0 at the final time. The initial attitude is given by the identity matrix and the angular 
velocity is given by u> = [O.lsin(i) O.lcos(t) (3 x 360/30) x (7r/180)] T rad/sec. The VIS- 
NAV sensor FOV is assumed to be 100 degrees. Therefore, any LOS measurement that is 
greater than 50 degrees from the boresight is not available. Since the last four beacons are 
“close in,” they are available throughout the entire simulation. The availability of the first 
four beacons is shown in Figure 3(i), where 1 indicates that the beacon is available and 0 
indicates that it is not available. The first four beacons are all available until about 20 sec- 
onds into the simulation run. Synthetic measurements are generated using the covariance 
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(i) Roll Errors and 3 cr Bounds 


(ii) Pitch Errors and 3 a Bounds 



(iii) Yaw Errors and 3<r Bounds (iv) Percent Difference Between QUEST and 

NEW Model 


Figure 4 Extended Kalman Filter Results 


in Eq. (3) with d — 1 and a = (100/5000) x (7 t/ 180) radians. These measurements are 
then converted into unit- vector form to be used in the EKF. The gyro noise parameters are 
given by a u — y/l0 x 1CT 10 rad/sec 3 / 2 and a v = y/lO x 10 -7 rad/sec 1 / 2 . See Ref. [17] for 
a detailed explanation of the gyro model. The initial biases for each axis of the gyro are 
given by 0.1 deg/hr. 

Two EKFs are executed. Both EKFs use the same exact synthetic LOS and gyro 
measurements, and both use Murrell’s version shown in Figure 2. The first EKF uses the 
QUEST model approach for the measurement covariance with Ri = cr 2 hx3' The second 
EKF uses the new measurement covariance model Rf EW . A plot of the average angle from 
the boresight for all the available beacons is shown in Figure 3(ii). The discontinuities are 
due to a loss of a beacon at that specific time. In general we expect that when the average 
angle is small, then using the QUEST model in the EKF should yield approximately the 
same solution as using the new model. Plots of the roll, pitch and yaw errors for a typical 
simulation run, with their respective 3 a bounds computed from the error covariance, are 
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Figure 5 Extended Kalman Filter Results for Large Roll Initial Condition Error 


shown in Figures 4(i)-4(iii), respectively. The top plot of each figure corresponds to using 
the QUEST model in the EKF and the bottom plot corresponds to using the new model 
approach. At first glance it seems as though both approaches yield nearly identical results, 
but closer inspection shows that this is not true. To investigate the performance aspects 
of both filters, the percent difference between the 3a attitude bounds is computed. The 
results are shown in Figure 4(iv). Using the QUEST model approach gives a 3a bound 
that is always larger than the new model approach. As expected, when the average angle 
from the boresight is small the percent differences are negligible. But when the' angle is 
large, using the QUEST model can lead to significantly large errors, as seen by the 30 
percent difference in the yaw error. An augmented filter that estimates attitude as well 
as position has also been developed. The state vector is augmented by six states, which 
model the three accelerations as zero-mean Gaussian white-noise processes. The position 
improvements using the new covariance are nearly the same as the attitude improvements, 
and thus are not shown here for brevity. Overall, the simulation results clearly show that 
the new covariance model can provide better results over the QUEST model for large FOV 
sensors. 

A comparison between the covariance decomposition approach and the rank-one update 
approach has also been done. The decomposition approach is found to be sensitive to nu- 
merical ill-conditioning effects. In fact large errors are present for the simulation results 
shown in Figure 4(iv) when the U-D factorization is not used, i.e. running the standard 
EKF equations. This does not occur with the rank-one update approach. The convergence 
properties of each approach has also been studied. A roll error of 180 degrees is introduced 
at the initial condition and the variance for that part of the initial covariance of the EKF is 
set to [(220/3) x (7 t/ 180)] 2 rad 2 for both approaches. For this error both approaches do not 
converge well. But, for this test the decomposition approach uses the U-D factorization, 
while the rank-one update approach uses the standard EKF equations. A U-D factoriza- 
tion for the rank-one update approach has also been designed. The results of the U-D 
factorization EKF version for both the decomposition and rank-one update approaches are 
shown in Figure 5. Clearly, the rank-one update approach produces better convergence 
behaviors than the decomposition approach. Several other initial condition errors have also 
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been tested, as well as a number of Monte Carlo-type simulations. When using the U-D 
factorization EKF version for both approaches, the rank-one update approach always shows 
better convergence behaviors than the decomposition approach. Further improvements may 
be obtained by using an Unscented filter [18]. 

CONCLUSIONS 

In this paper a new measurement covariance model was derived that can be used for 
large field-of-view sensors. The new model was derived using a first-order Taylor series 
expansion approach of the line-of-sight measurement model. Due to the singular nature of 
the new covariance, straightforward implementation of the extended Kalman filter was not 
possible. This was overcome by using one of two approaches. The first approach involves 
decomposing the covariance matrix into its eigenvalues and eigenvectors, and then perform- 
ing a transformation of state so that a reduced nonsingular matrix is used in the extended 
Kalman filter. The second approach adds a simple term, i.e. a rank-one update, to the 
covariance matrix that does not alter the overall Kalman gain. Simulation results indicate 
that the new model can yield better estimation results over using the small field-of-view 
QUEST measurement model in the filter design. Also, a comparison of the two approaches 
showed that the rank-one update approach can provide better convergence properties than 
the decomposition approach for large initial condition errors. Also, the rank-one update 
approach allows a designer to easily implement the extended Kalman filter, even if the 
QUEST measurement model is used for the measurement covariance. For these reasons, 
the rank-one update approach is preferred over the decomposition approach. 
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